|  j.  |  Defence  Research  and  Recherche  et  developpement 
M  w  m  Development  Canada  pour  la  defense  Canada 


DEFENCE 


Extreme  Agility  Micro  Aerial  Vehicle  - 
Control  of  hovering  maneuvers  for  a 
mini-aerial  vehicle  with  an  onboard 
autopilot  system 


P.-R.  Bilodeau 
AEREX  Avionique  inc. 

EC.  Wong 
DRDC  Valcartier 


Defence  R&D  Canada  -  Valcartier 

Technical  Report 
DRDC  Valcartier  TR  2010-144 
February  2011 


Canada 


Extreme  Agility  Micro  Aerial  Vehicle  -  Control 
of  hovering  maneuvers  for  a  mini-aerial 
vehicle  with  an  onboard  autopilot  system 

P.-R.  Bilodeau 
AEREX  Avionique  inc. 

RC.  Wong 
DRDC  Valcartier 


Defence  R&D  Canada  -  Valcartier 

Technical  Report 

DRDC  Valcartier  TR  2010-144 

February  201 1 


Principal  Author 


Pierre-Richard  Bilodeau,  Franklin  Wong 


Approved  by 


M.  Lauzon 

Head/Precision  Weapons  Section 


Approved  for  release  by 


C.  Carrier 

Head/Document  Review  Panel 


©  Her  Majesty  the  Queen  in  Right  of  Canada  as  represented  by  the  Minister  of 
National  Defence,  2011 

©  Sa  Majeste  la  Reine  (en  droit  du  Canada),  telle  que  representee  par  le  ministre 
de  la  Defense  nationale,  2011 


Abstract 


Mini  Aerial  Vehicles  (MiniAV)  are  involved  in  various  unmanned  missions  for  both 
civil  and  military  applications.  These  airplanes  benefit  from  high  maneuverability  and 
can  generally  execute  hovering  and  other  acrobatic  maneuvers.  The  small  size  of  these 
vehicles,  combined  with  their  high  maneuverability,  have  inspired  numerous  research 
studies  in  which  these  vehicles  are  envisioned  for  use  in  missions  involving  hazardous 
locations  or  situations  in  which  human  lives  are  at  risk.  The  theoretical  basis  for 
measuring  the  attitude  and  altitude,  and  stabilizing  a  mini-aerial  vehicle  while  being 
flown  in  a  hovering  position  is  presented.  A  cascaded  PI  control  architecture  based 
on  quaternion  attitude  measurements  and  a  PID  altitude/throttle  controller  with 
anticipation  due  to  aileron  perturbations  were  formulated  and  implemented  on  an 
onboard  autopilot.  The  implementation  of  the  controllers  on  the  onboard  autopilot 
reduced  system  delays  observed  from  an  off  board  controller  implementation  from 
0.17  s  to  0.05  s.  The  result  was  a  significant  increase  in  the  gain  margin  from  roughly 
6  to  17  dB  in  the  pitch  and  yaw  axes.  The  experimental  data  showed  that  throttle 
commands,  compensated  for  aileron  effects  through  an  anticipation  function,  reduced 
the  altitude  hold  error  from  ±25  cm  to  ±10  cm,  thereby  validating  the  necessity  of  a 
roll-throttle  decoupler  to  stably  hover  an  aircraft  of  this  type  at  a  fixed  altitude. 


Resume 


Les  vehicules  aeriens  miniatures  (MiniAV)  participent  a  diverses  missions  sans  pilote 
pour  des  applications  civiles  et  militaires.  Ces  avions  possedent  d’une  manoeuvra¬ 
bility  elevee  et  peuvent  en  general  executer  des  manoeuvres  de  vol  stationnaire  et 
d’autres  manoeuvres  acrobatiques.  La  petite  taille  de  ces  vehicules,  combinee  a  leur 
manoeuvrability  elevee,  ont  inspire  de  nombreuses  etudes,  notamment  pour  des  mis¬ 
sions  dans  des  endroits  dangereux  ou  dans  des  situations  ou  des  vies  humaines  sont  en 
danger.  La  base  theorique  de  mesure  de  l’attitude  et  de  l’altitude,  et  la  stabilisation 
d’un  vehicule  aerien  miniature  pendant  le  vol  stationnaire  est  presentee.  Une  archi¬ 
tecture  de  cascade  PI  de  controle  basee  sur  des  mesures  de  l’attitude  en  quaternion 
et  un  controleur  de  L altitude/throttle  PID  avec  anticipation  due  a  des  perturbations 
d’aileron  ont  ete  tommies  et  implementes  sur  un  autopilote  a  bord.  La  mise  en  oeuvre 
des  controleurs  sur  le  pilote  automatique  a  bord  reduit.  les  retards  precedents  de  0,17  s 
a  0,05  s.  Le  resultat  etait  une  augmentation  significative  de  la  marge  d’amplitude, 
passant  d’environ  6  a  17  dB  dans  les  axes  de  tangage  et  de  lacet.  Les  donnees  expe- 
rimentales  ont  montre  que  les  commandes  d’accelerateur  ont  compense  les  effets  des 
ailerons  par  une  fonction  d’anticipation,  reduit  l’erreur  de  tenue  d’altitude  a  partir  de 
±25  cm  a  ±10  cm,  validant  ainsi  la  necessity  d’un  deployment  decoupleur  papillon 
des  gaz  pour  faire  planer  un  avion  de  ce  type  de  fagon  stable  et  a  une  altitude  fixe. 
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Executive  summary 


Extreme  Agility  Micro  Aerial  Vehicle  -  Control  of 
hovering  maneuvers  for  a  mini-aerial  vehicle  with  an 
onboard  autopilot  system 

P.-R.  Bilodeau,  F.C.  Wong;  DRDC  ValcartierTR  2010-144;  Defence  R&D  Canada 

-  Valcartier;  February  201 1 . 

Mini  Aerial  Vehicles  (MiniAV)  are  involved  in  various  unmanned  missions  for  both 
civil  and  military  applications.  According  to  UAV  classification,  the  proposed  acronym 
MiniAV  can  refer  to  small  airplanes  which  have  a  wing  span  of  less  than  one  meter 
and  a  weight  less  than  five  hundred  grams.  These  airplanes  benefit  from  high  maneu¬ 
verability  and  can  generally  execute  hovering  and  other  acrobatic  maneuvers.  The 
small  size  of  these  vehicles,  combined  with  their  high  maneuverability,  have  inspired 
numerous  research  studies  in  which  these  vehicles  are  envisioned  for  use  in  missions 
involving  hazardous  locations  or  situations  in  which  human  lives  are  at  risk.  Typical 
applications  involve  inspection  of  collapsed  buildings,  structural  inspection  of  bridges 
and  reconnaissance  for  soldiers  in  urban  scenarios. 

The  MiniAV  in  this  study  is  a  mini-fixed  wing  aerial  vehicle  which  has  an  unstable 
behavior  that  makes  manually  hovering  difficult  for  an  inexperienced  pilot.  The  im¬ 
plementation  of  an  automated  hovering  control  strategy  is  thus  necessary  if  a  MiniAV 
is  to  be  useful  for  a  mission  specialist  whose  main  purpose  is  to  inspect  or  search  a 
building  rather  than  to  fly  the  MiniAV. 

In  this  report,  the  culmination  of  the  effort  to  implement  an  onboard  autopilot  run¬ 
ning  a  control  law  capable  of  hovering  a  MiniAV  for  the  Extreme  Agility  Micro  Aerial 
Vehicle  Applied  Research  Project  is  presented.  The  theoretical  basis  for  measuring 
the  attitude  and  altitude,  and  stabilizing  a  mini-aerial  vehicle  while  being  flown  in  a 
hovering  position  is  developed.  A  cascaded  PI  control  architecture  based  on  quater¬ 
nion  attitude  measurements  and  a  PID  altitude/throttle  controller  with  anticipation 
due  to  aileron  perturbations  were  formulated  and  implemented  on  an  onboard  au¬ 
topilot.  A  complementary  filter  was  employed  to  improve  the  stability  and  reliability 
of  the  attitude  measurements  that  fed  the  controllers.  Tuning  of  the  attitude  and  al¬ 
titude/throttle  control  gains  was  first  accomplished  on  a  calibrated  dynamic  airplane 
model  using  a  frequency  response  method  to  meet  the  desired  performance  goals. 
The  calculated  gains  did  not  change  significantly  when  implemented  in  the  test  ve¬ 
hicle,  indicating  that  the  airplane  model  dynamics  were  identified  with  good  fidelity. 
The  implementation  of  the  controllers  on  the  onboard  autopilot  reduced  system  de¬ 
lays  from  an  off  board  controller  implementation  from  0.17  s  to  0.05  s.  The  result 
was  a  significant  increase  in  the  gain  margin  from  roughly  6  to  17  dB  in  the  pitch 
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and  yaw  axes.  This  increase  in  margin  means  that  the  controller  is  able  to  handle 
greater  model  gain  uncertainties  and  to  better  reduce  oscillations  if  the  vehicle  is 
perturbed  from  its  equilibrium  position.  The  experimental  data  showed  that  throttle 
commands,  compensated  for  aileron  effects  through  an  anticipation  function,  reduced 
the  altitude  hold  error  from  ±25  cm  to  ±10  cm,  thereby  validating  the  necessity  of  a 
roll-throttle  decoupler  to  stably  hover  an  aircraft  of  this  type  at  a  fixed  altitude. 
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Les  vehicules  aeriens  miniature  (MiniAV)  participent  a  diverses  missions  sans  pilote 
pour  des  applications  civiles  et  militaires.  Selon  la  classification  des  vehicles  aeriens 
inhabites  (UAV),  l’acronyme  propose  peut  referer  aux  avions  de  petite  taille  qui  ont 
une  envergure  de  moins  d’un  metre  et  un  poids  de  moins  de  cinq  cents  grammes. 
Ces  avions  beneficient  d’une  grande  manoeuverabilite  et  peuvent  effectuer  le  vol  sta- 
tionnaire  et  d’autres  manoeuvres  acrobatiques.  La  petite  taille  de  ces  vehicles  et  leur 
manoeuvrability  ont  inspire  des  nombreuses  etudes  ou  ces  vehicles  sont  utilises  dans 
des  missions  impliquant  des  lieux  ou  des  situations  dangereuses.  Parmi  les  applica¬ 
tions  typiques  figurent  l’inspection  des  batiments  ecoules,  l’inspection  structurellc  des 
ponts  et  la  reconnaissance  des  soldats  dans  les  operations  urbaines. 

Le  MiniAV  dans  cette  etude  est  un  avion  a  aile  fixe  avec  un  comportement  instable 
qui  empeche  un  pilote  sans  experience  de  bien  le  controler  en  vol  stationnaire.  L’im- 
plementation  d’une  strategic  de  controle  pour  automatiser  le  vol  stationnaire  est 
necessaire  si  le  MiniAV  devient  utile  pour  une  specialiste  en  mission  qui  a  la  tache 
d’inspecter  ou  de  chercher  un  batiment  plutot  que  de  faire  voler  le  MiniAV. 

Dans  ce  rapport,  1’ about issement  des  efforts  deployes  pour  mettre  en  oeuvre  un  auto- 
pilote  a  bord  en  cours  qui  execute  une  loi  de  controle  capable  de  vol  stationnaire  Mi¬ 
niAV  pour  le  projet  de  recherche  appliquee  ’Extreme  Agility  Micro  Aerial  Vehicle’  est 
presente.  La  base  theorique  pour  mesurer  l’attitude  et  l’altitude,  et  la  stabilisation  du 
MiniAV  lorsqu’il  est  en  vol  stationnaire  est  developpee.  Une  architecture  de  controle 
proportionelle-integrale  (PI)  en  cascade  basee  sur  des  mesures  de  l’attitude  quaternion 
et  un  controlleur  proportionelle-integrale-derivee  (PID)  pour  l’altitude/accelerateur 
avec  anticipation  due  aux  perturbations  des  ailerons  ont  ete  formules  et  implementes 
sur  un  autopilote  a  bord  1’avion.  Un  filtre  complementaire  a  ete  employe  afin  d’amelio- 
rer  la  stability  et  la  fiabilite  des  mesures  d’attitude  qui  ont  alimente  les  controleurs. 
Le  reglage  des  gains  pour  les  controleurs  de  l’attitude  et  de  l’altitude/accelerateur 
ont  ete  accomplis  premierement  avec  un  modele  dynamique  et  etalonne  en  utilisant 
la  methode  de  frequence  pour  obtenir  les  comportements  desires.  Les  gains  calcules 
n’ont  pas  change  significativement  quand  ils  ont  ete  implementes  dans  le  vehicle  de 
test,  ce  qui  signifie  que  la  dynamique  a  ete  identifiee  avec  une  bonne  fidclite.  L’imple- 
mentation  des  controleurs  dans  l’autopilote  a  reduit  les  delais  precedents  de  0,17  s  a 
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0,05  s.  Le  resultat  a  ete  une  augmentation  appreciable  de  la  marge  d’amplitude  de  6 
a  17  dB  dans  les  axes  de  tangage  et  de  lacet.  Cette  augmentation  en  marge  permet  au 
controleur  de  gerer  les  plus  grandes  incertitudes  dans  les  gains  et  reduit  plus  rapide- 
ment  les  oscillations  si  le  vehicle  est  perturbe  de  sa  position  d’equilibre.  Les  donnees 
experimentales  ont  montre  que  les  commandes  d’accelerateur  qui  ont  ete  compensees 
pour  les  effets  des  ailerons  par  une  fonction  d’anticipation,  a  reduit  l’erreur  en  alti¬ 
tude  constante  de  ±25  cm  a  ±10  cm  et  a  permis  de  valider  la  necessity  d’avoir  une 
decouplage  entre  le  roulis  et  l’accelerateur  pour  voler  en  altitude  constante  de  fagon 
stable  et  stationnaire  avec  ce  type  d’avion. 
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1  Introduction 


Mini  Aerial  Vehicles  (MiniAV)  are  involved  in  various  unmanned  missions  for  both 
civil  and  military  applications.  According  to  the  classification  given  by  Mueller  and 
al.  (2007),  the  proposed  acronym  MiniAV  can  refer  to  small  airplanes  which  have  a 
wing  span  of  less  than  one  meter  and  a  weight  of  less  than  five  hundred  grams.  The 
small  size  of  these  vehicles,  combined  with  their  high  maneuverability,  have  inspired 
numerous  research  studies  in  which  these  vehicles  are  envisioned  for  use  in  missions 
involving  hazardous  locations  or  situations  in  which  human  lives  are  at  risk.  Typical 
applications  involve  inspection  of  collapsed  buildings,  structural  inspection  of  bridges 
and  reconnaissance  for  soldiers  in  urban  scenarios. 

There  are  three  essential  criteria  for  any  man-carried  airborne  sensor:  1)  it  must  be 
able  to  fly  at  very  low  forward  speed,  2)  it  must  be  structurally  robust,  and  3)  it 
must  be  able  to  fly  by  itself.  To  address  the  first  two  points,  several  types  of  MAVs 
have  been  developed  in  the  past.  Fixed-wing  designs  are  structurally  robust  but 
they  cannot  fly  at  very  slow  forward  speeds  in  standard  attitudes.  Rotorcraft  designs 
can  fly  slowly  except  their  mechanical  control  system  is  not  structurally  robust  in 
comparison  to  a  fixed-wing  design.  An  alternative  to  these  two  types  of  platforms  is 
a  platform  that  is  capable  of  hybrid  mode  flight.  For  example,  if  a  high  performance 
lightweight  fixed-wing  MAV  can  be  commanded  to  execute  fast  level  flight  or  to 
execute  a  maneuver  known  as  ’prop  hanging’  or  ’hovering’  for  slow  forward  flight, 
the  characteristics  of  structural  robustness  and  slow  flight  may  be  obtained  with  a 
fixed-wing  design.  Manually  piloting  a  fixed-wing  MAV  to  hover  for  an  extended 
length  of  time  takes  great  concentration  and  skill.  If  the  hovering  maneuver  can  be 
automated,  then  it  is  possible  to  create  a  robust,  slow  flying  airborne  sensor  that  a 
soldier  can  use  with  little  effort. 

A  structured  approach  for  developing  and  implementing  controllers  generally  involves 
mathematical  models  of  the  system  to  be  controlled.  This  topic  was  covered  by 
Bilodeau  (2009)  for  a  vehicle  that  used  an  offboard  controller.  In  this  study,  which 
is  a  sequel  to  Bilodeau  (2009) ’s  work,  an  onboard  control  system  is  implemented  on 
the  vehicle. 

In  the  literature,  several  authors  proposed  a  systematic  approach  to  design  fixed 
wing  control  strategies  for  hovering  based  on  an  identified  model  composed  of  lin¬ 
ear  transfer  functions.  Green  and  Oh  (2005,  2006a, b)  and  Green  (2007)  suggested 
standard  proportional-integral-derivative  (PID)  controllers  based  on  quaternion  atti¬ 
tude  representation.  To  adjust  controller  parameters,  the  authors  used  an  empirical 
and  iterative  method.  Satisfactory  results  were  obtained  with  a  commercial  iner¬ 
tial  measurement  unit  (IMU)  and  an  airframe  similar  to  the  one  discussed  in  this 
report.  However,  a  major  difference  compared  to  the  present  work  is  that  Green 
added  extra  motors  to  the  wing  tips  to  improve  the  control  authority  of  the  system. 
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Knoebel  et  al.  (2006),  Knoebel  (2007),  Knoebel  and  Me  Lain  (2008)  compared  non- 
adaptive  regulators  with  gain  scheduling  based  on  the  main  air  stream  speed  with 
more  sophisticated  adaptive  regulators.  The  proposed  non-adaptive  regulators  base 
structure  is  very  similar  to  the  one  studied.  Mechanical  parameters  were  estimated 
with  thin  airfoil  theory  (Phillips  (2004)).  Adequate  performance  was  reached  for  a 
miniature  tail-sitter  airframe.  Frank  et  al.  (2007)  presented  a  theoretical  modeling 
method  where  the  parameters  were  obtained  by  estimation.  DeBlauwe  et  al.  (2007) 
identified  a  first  order  model  based  on  force  and  moment  equations.  This  approach 
required  a  measurement  or  an  accurate  estimation  of  the  translational  speed.  Such 
information  was  difficult  to  obtain  with  low  cost  sensors.  For  hovering  control,  both 
authors,  Frank  and  De  Blauwe,  proposed  full  state  feedback  regulators  tuned  with 
linear  quadratic  techniques  for  a  MiniAV  airframe.  However,  they  used  an  exter¬ 
nal  vision  system  to  obtain  feedback  variables.  Finally,  Stone  (2004)  determined  a 
model  of  a  fuel  engine  tail  sitter  with  a  system  identification  approach.  LQR  and 
P1D  controllers  were  designed.  While  Stone’s  airframe  is  too  large  for  our  envisioned 
indoor  operations,  the  modeling  approach  was  retained  for  identifying  the  airframe 
in  Bilodeau  (2009). 

This  report  documents  the  implementation  of  an  onboard  autopilot  and  control  law 
that  allows  a  mini-aerial  vehicle  to  execute  a  stable  hovering  maneuver.  The  work  was 
sponsored  under  the  DRDC  Partner  Group  2,  Sense  Thrust  Advisory  Group,  applied 
research  project  entitled  ’Extreme  agility  micro-aerial  vehicle  concepts  for  complex 
terrain  warfare’  between  2007  and  2009.  The  information  provided  is  a  culmination 
of  the  effort  carried  out  in  the  work  breakdown  element  ’Flight  Control’. 

The  objective  of  this  report  is  to  present  the  performance  obtained  with  a  complete 
control  system  mounted  onboard  the  MiniAV  rather  than  the  hybrid  onboard  wire¬ 
less  inertial  measurement  unit  and  offboard  controller  previously  used  by  Bilodeau 
(2009).  As  a  secondary  objective,  the  report  will  demonstrate  that  simple  sensor 
fusion  algorithms  can  estimate  correctly  the  attitude  of  a  hovering  air  vehicle.  The 
report  is  separated  as  follows.  A  theoretical  overview  of  the  reference  frame  defi¬ 
nitions,  quaternion  representation,  complementary  Liter,  and  controller  architecture 
and  tuning  method  is  given.  Then,  the  testbed  used  to  produce  the  results  is  pre¬ 
sented.  The  fusion  Liter  implementation  is  assessed  and  is  followed  by  a  presentation 
of  the  MiniAV  model  used  for  control  tuning.  Finally,  experimental  validation  results 
of  the  model  and  controllers  are  presented. 
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2  Theory 


This  chapter  presents  the  theoretical  basis  of  the  reference  frames,  quaternion  attitude 
representation,  and  the  attitude  estimation  filter  (complementary  filter).  A  descrip¬ 
tion  of  the  control  inputs  is  provided.  Finally,  the  control  theory  for  the  complete 
attitude  regulation  is  presented. 


2.1  Reference  Frames 

There  are  two  main  reference  frames  used  in  this  document.  The  first  is  an  inertial 
reference  frame  denoted  as  Re  and  defined  as  the  North-East-Down  (NED)  reference 
frame.  The  earth  axes,  Xe,  Ye  and  Ze,  are  oriented  toward  north,  east  and  down, 
respectively.  The  second  reference  frame  is  the  body  axis  reference  frame  denoted  as 
Rb  and  is  attached  to  the  body  of  the  air  vehicle  as  illustrated  in  Figure  1.  Also,  the 
origin  of  the  body  axes  is  located  at  the  vehicle’s  center  of  mass.  The  Yb  and 
Zb  axes  point  toward  the  front,  right  and  ventral  side  of  the  air  vehicle,  respectively. 
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2.2  Selected  Attitude  Representation  :  The  Quaternion 

Phillips  et  al.  (2001)  made  a  review  of  the  popular  attitude  representations  used  for 
aircraft  kinematics.  The  authors  presented  the  well-known  Euler  angles,  Euler-axis 
rotation  parameters,  direction  cosines  and  Euler-Rodrigues  quaternion.  From  the 
authors’  conclusions,  the  quaternion  is  by  far  superior  to  the  other  attitude  represen¬ 
tations  based  on  the  computational  cost  alone.  Also,  the  quaternion  can  represent 
any  orientation  without  the  singularity  problem  that  Euler  angles  encounter  when 
orientations  of  ±90°  occur.  The  direction  cosine  does  not  possess  singularities  but  it 
takes  more  computational  power  because  there  are  nine  elements  to  integrate  versus 
four  for  quaternions.  Thus,  the  quaternion  was  selected  for  the  implementation  of  the 
attitude  estimator  and  of  the  attitude  controllers  even  though  they  are  less  intuitive 
in  their  interpretation. 

This  section  presents  a  summary  of  quaternion  properties  used  for  implementation  of 
the  control  algorithms.  For  a  more  detailed  description  of  quaternion  properties,  see 
Kuipers  (1999). 

2.2.1  Quaternion  Defined 

In  what  follows,  a  quaternion  will  always  be  denoted  by  a  lower-case  letter,  say  p  or 
q  or  r.  Bold-faced  letters  are  used  to  denote  ordinary  vectors  in  three  dimensional 
space,  namely  R3.  To  denote  the  standard  orthonormal  basis,  i,  j  and  k  are  used  and 
these  vectors  are  writen  as 


i  =  (1,0,0) 

j  =  (0,1,0) 
k=  (0,0,1) 

A  quaternion  is  composed  of  four  real  numbers  or  scalars  and  can  be  written  as 


q  =  ( qw,qx,qy,qz ) 

To  better  understand  the  nature  of  the  quaternion,  an  alternative  way  of  representing 
it  is  to  first  define  a  scalar  part,  say  qw.  Then,  a  vector  part,  say  q,  which  is  a  vector 
defined  in  R 3  as 

q  =  i  qx+  tey  +  k  qz 

where  i,  j  and  k  are  the  standard  orthonormal  basis  in  R3.  Now,  the  quaternion  can 
be  defined  as  the  sum 

q  =  qw  +  q 

where  qw  is  the  scalar  part  and  q  is  the  vector  part  of  the  quaternion. 
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2.2.2  Multiplication  Defined 


Let  the  definition  of  the  product  of  two  quaternions,  p  and  q,  be  r  =  pq.pq.  pq  can 
be  written  in  the  following  form 

pq  =  PwQw  ~  P  q  +  Pw<l  +  qw P  +  p  X  q 
which  can  be  expand  in  the  following  form 

^  w  PwQw  PxQx  PyQy  PzQz 

rx  =  pxqw  +  pwqx  ~  pzqy  +  PyQz 
ry  =  pyqw  +  pzqx  +  pwqy  -  pxqz 
rz  =  pzqw  -  pyqx  +  pxqy  +  pwqz 
or  if  written  in  matrix  notation 


rw 

Pw  -Px  -py  -pz 

qw 

rx 

Px  Pw  - Pz  Py 

qx 

rv 

Py  Pz  Pw  Px 

qy 

rz_ 

Pz  Py  Px  Pw 

Qz_ 

2.2.3  The  Complex  Conjugate  Defined 

The  complex  conjugate  of  the  quaternion  q  =  qw  +  q  =  qw  +  iqx  +  j qy  +  k qz,  denoted 
q*,  is  given  by 

q*  =  qw  -  q  =  qw  -  kx  -  kv  -  k qz  (2) 

When  the  complex  conjugate  is  applied  to  a  product  of  quaternions,  the  result  is  the 
product  of  the  individual  complex  conjugates  in  a  reversed  order.  Given  any  two 
quaternion  p  and  q,  we  have 

(pq)*  =  q*p* 


2.2.4  The  Norm  Defined 

The  norm  of  a  quaternion  is  defined  by 

N(q)  =  k¥q  =  \J ql  +  ql  +  qy  +  q2z  =  |g|  (3) 

Further,  a  unit  quaternion,  N(q)  =  1,  will  always  be  assumed. 

2.2.5  The  Inverse  Defined 

As  demonstrated  in  Kuipers  (1999),  specifying  N(q)  =  1  gives  the  following  equality 

q~l  =  q*  (4) 

which  describes  the  quaternion  inverse  q~l  as  equal  to  the  quaternion  complex  con¬ 
jugate. 
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2.2.6  Operator  Sequences  Defined 


The  quaternion  rotation  operator  can  be  used  for  two  different  applications.  The 
first  one  is  to  apply  one  or  many  rotations  to  a  vector,  say  u,  while  keeping  the  same 
reference  frame  all  along  the  operations.  The  second  one  is  to  change  the  reference 
frame  of  the  vector  to  another  frame  of  reference.  To  illustrate  the  difference  between 
these  two  applications,  let  us  define  the  vectors  u,  v  and  w  which  are  illustrated  in 
Figure  2. 


4 


4 


Figure  2:  Rotation  operator  composition  LqoLp 

To  express  a  rotation  sequence  of  a  vector  u  to  the  final  vector  w,  let  p  and  q  be  the 
unit  quaternions  which  define  the  quaternion  rotation  operators 


and 


Lp(u)  =  pup* 
L?(v)  =  qvq* 


Therefore,  w  can  be  obtained  as  follows 


W  =  Lq(V) 

=  qvq* 

=  q(pup*)q* 

=  (qp)u(qp)*  =  L 


This  result  means  that  the  quaternion  equal  to  the  rotation  from  u  to  w  is  qp  and 
can  be  read  as  the  rotation  p  followed  by  the  rotation  q. 


Now,  if  one  wants  to  express  u  in  the  reference  frame  of  w,  the  operator  Lp  and  Lg 
must  be  redefined  as  follows 


and 


Lp(u)  =  p*up 


L?(v)  =  q*vq 
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Therefore,  to  express  u  in  the  reference  frame  where  w  stands,  one  must  apply  the 
following  logic 


W  =  Lq(V) 

=  q*\q 
=  q*(p*up)q 
=  (pqYu(pq)  =  Lpq 

This  gives  an  equivalent  rotation  pq  which  can  also  be  read  as  the  rotation  p  followed 
by  the  rotation  q. 

The  two  rotation  sequence  orders  are  summarized  in  Table  1. 

Table  1:  Rotation  sequence  orders 


Type  of  rotation 

p  followed  by  q 

Rotation  operator 

Vector  rotation 

qp 

(qp)u(qp)* 

Frame  rotation 

pq 

(pq)*u(pq) 

2.2.7  Kinematic  Equation  Defined 

The  kinematic  equation  of  the  quaternion  introduces  the  quaternion  derivative  q  and 
the  pure  quaternion,  say  p(f2),  expressing  the  body  axis  angular  rates  in  a  quaternion 
formulation  where  f2  =  [cjx,iOy,ooz].  p(f2)  can  be  written  as 

p(fl)  =  [0,ux,uv,ug]T 

With  these  terms  defined,  the  kinematic  equation  is  given  by 

q  =  ^gp(O) 

2.2.8  Conversion  to  Euler  Angles 

Because  the  quaternion  is  not  very  intuitive  and  because  Euler  angles  can  be  attached 
directly  to  the  body  axis,  the  Euler  angles  offer  a  better  physical  visualization  and 
data  interpretation.  The  conversion  from  quaternions  to  Euler  angles  are 


</>  =  arctan 


T  qyqz)  \ 

1  -  2 (<£  +  Qy)  J 


(5) 
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8  -  arcsin  2{qwqy  -  qxqz) 


(6) 


^  =  arctan 


‘^‘(QxQy  QwQz)  j 

1  -  2 (q2y  +  ql)  J 


(7) 


2.3  Attitude  Estimation  (Complementary  Filter) 

In  past  studies,  Phillips  et  al.  (2001)  reviewed  popular  attitude  representations  for 
aircraft  kinematics.  The  authors  examined  Euler  angles,  Euler-axis  rotation  param¬ 
eters,  direction  cosines  and  the  Euler-Rodrigues  quaternion.  The  authors  concluded 
that  the  quaternion  was  by  far  superior  to  other  representations  based  on  the  com¬ 
putational  cost  alone. 

To  improve  the  stability  and  reliability  of  the  attitude  signals  feeding  controllers, 
several  authors  (Yun  and  Bachmann  (2006),  Ahmadi  et  al.  (2007))  proposed  the  use 
of  Kalman  filters  which  in  practice  are  not  very  easy  to  implement  on  embedded 
systems.  Hamel  and  Mahony  (2006),  Mahony  et  al.  (2006),  Metni  et  al.  (2006)  used 
a  complementary  filter  to  estimate  attitudes  for  vertical  take-off  and  landing  (VTOL) 
UAVs.  The  attitude  estimation  algorithm  proposed  by  Hamel  and  Mahony  (2006) 
which  is  based  on  an  explicit  complementary  filter  is  used  here.  Since  the  micro¬ 
controller  has  limited  computational  resources,  the  implementation  of  the  filter  is 
based  on  the  quaternion  representation  instead  of  the  rotation  matrix  implemented 
by  Hamel  and  Mahony  (2006). 


2.3.1  Attitude  Filter  Architecture 

The  attitude  filter  architecture  is  illustrated  in  Figure  3  and  can  be  separated  in 
two  parts.  The  first  part  consists  of  the  quaternion  kinematic  equation  q  =  ^qp(fi) 
described  in  subsection  2.2.7  where  f2  is  the  corrected  angular  rate  vector.  If  no 
corrections  are  made  to  the  rate-gyros  measurements  f P,  the  rate-gyros  bias  will  be 
integrated  and  the  quaternion  estimate  will  drift  in  time. 

To  reduce  the  drift  in  the  attitude  estimation,  the  complementary  filter  estimates 
the  rate-gyros  bias  with  inertial  measurements.  One  can  use  only  accelerometers 
readings  ay  or  in  combination  with  flux- magnetometers  readings  m:y  to  improve  the 
estimate  of  the  rate-gyros  bias.  Flux-magnetometers  were  not  retained  here  because 
the  hardware  employed  in  this  project  did  not  possess  a  tri-axis  magnetometer.  Even 
if  a  tri-axis  magnetometer  was  available,  it  is  very  likely  that  it  would  not  give  reliable 
measurements  inside  buildings  due  to  the  presence  of  metallic  structures.  This  topic 
is  discussed  by  Bachmann  et  al.  (2007). 
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Sl> 


Figure  3:  Complementary  filter  based  on  the  quaternion  formulation 


To  estimate  the  rate-gyro  bias,  an  estimate  of  the  inertial  sensor  measurements  v*  is 
first  done  by  transposing  the  nominal  values  of  the  measured  inertial  quantities  on 
the  body  axis  reference  frame.  This  is  done  with  the  equation  v  =  q*v0q.  Then, 
the  estimated  readings  can  be  compared  with  the  inertial  sensors  readings  with  the 

n 

equation  uj  =  fcjVj  x  v,:  where  kt  is  a  confidence  gain  and  n  is  the  number  of  inertial 

i= 1 

sensor  triads.  In  general,  accelerometers  provide  low  noise  readings,  thus  a  gain  near 
1.0  is  generally  retained.  However,  the  accelerometer  estimates  will  differ  from  the 
measurements  if  the  body  is  accelerating  and  this  will  produce  a  perturbation  on  the 
bias  estimate.  To  avoid  this  from  occuring,  the  accelerometers  confidence  gain  k\  is 
modified  as  a  function  of  the  measured  acceleration  with  a  penalty  gain  kpenauy.  The 
more  the  body  is  accelerating,  the  lower  the  confidence  in  the  gravitational  accel¬ 
eration  readings,  is  an  instantaneous  improvement  vector  which  is  used  directly 
to  correct  fly  and  to  estimate  the  rate-gyro  bias  through  integration.  Finally,  the 
dynamics  of  the  filter  can  be  tuned  with  the  parameters  k°  and  k°  which  are  the 
proportional  and  integral  gains  of  the  filter  observer,  respectively. 


2.3.2  Filter  Tuning 


The  classical  complementary  filter  equation,  given  by  Metni  et  al.  (2006),  is 


X(s) 


s 2  +  k°s  +  k 1 


XM 


k°s  +  k° 

-5—^ - —rX{s 

s 2  +  k°s  +  k° 


(8) 


where  X(s)  represents  the  estimated  attitude,  X^(s)  represents  the  estimated  attitude 
using  angular  rates  and  X(s)  represents  the  true  attitude.  From  equation  8,  it  is 
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possible  to  see  that  the  first  transfer  function  is  a  high  pass  filter  and  that  the  second 
transfer  function  is  a  low  pass  filter.  Also,  it  is  worth  noting  that  the  sum  of  these 
two  transfer  functions  is  equal  to  1.  This  property  is  the  reason  why  it  is  called  a 
complementary  filter. 

The  denominators  of  equation  8  follow  the  form  s2  +  2Ct(jj0s  +  cUq,  thus  the  following 
equalities 

K  =  2^0  (9) 

k°  =  ^  (10) 

can  be  extracted.  In  these  equalities,  £  is  the  damping  ratio  and  Uo  is  the  cutoff 
frequency. 


2.4  Comparing  Quaternions  from  the  Vision  System 
and  from  the  Complementary  Filter 


A  good  way  to  evaluate  the  performance  of  the  complementary  filter  is  to  compare  its 
attitude  estimates  with  the  attitudes  measured  by  a  vision  system.  Figure  4  illustrates 
the  different  reference  frames  encountered  when  using  a  vision  system  and  an  onboard 
autopilot  (Kestrel,  Procerus  Technologies).  There  are  four  reference  frames:  1)  the 
inertial  reference  frame  TZe,  2)  the  vision  system  reference  frame  IZy,  3)  the  body  axis 
reference  frame  of  the  autopilot  (Kestrel)  Tlse  and,  4)  the  body  axis  reference  frame  of 
the  vision  system  TZbv  The  quaternions  qkestrel  and  qmsion  are  known.  However,  the 
quaternions  q'  2E,  vision  frame  with  respect  to  inertial  frame,  and  qBv2Be ;  vision  body 
frame  with  respect  to  inertial  frame,  are  unknown  unless  measured.  These  unknown 
quaternions  can  be  determined  by  minimizing  the  cost  function  if  measurement  is  not 
an  option  as  was  the  case  here.  The  following  cost  function  was  used 


cost 

where  qe  is  defined  as 


0.5  *qex*qex  +  0.5  *qey*qey  +  0.5  *qez*q 


e. 

zi 


q 


e 


qA(qB ) 


-l 


and  where  qA  and  qB  are  defined  as 


qA  =  qV2Eq 

qB  =  qvisionq 


kestrel 

Bv2Be 


When  minimizing  the  cost  function,  it  is  very  important  to  apply  a  unitary  norm 
constraint  for  both  qA  and  qB .  Knowing  qx  2E  and  qBv2Bey  it  is  possible  to  calculate 
the  equivalent  quaternion  coming  from  the  vision  system  to  the  one  estimated  by 
the  complementary  filter  on  the  Kestrel  autopilot.  This  new  quaternion  is  named 

kestrel _from_vision  an(j  jg  (]efinef]  as 


q 


kestrel  _from_vision  ^Eyyision^Be 


q 
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qV2E 


Figure  4:  Vision  system  and  autopilot  reference  frames  definitions 

2.5  Attitude  Control 

2.5.1  Control  Inputs  of  a  Fixed  Wing  Aircraft 

The  available  control  surfaces  and  control  device  (see  Figure  5)  are  the  ailerons, 
the  elevator,  the  rudder  and  the  throttle.  The  variables  associated  to  these  inputs 
are  presented  in  Table  2  where  the  superscript  trim  represents  the  trim  value  of  the 
associated  input  and  where  the  superscript  cmd  represents  the  command  value  around 
the  operating  point.  The  units  of  these  input  variables  are  in  milliseconds  because 
they  represent  the  servo  commands  which  are  pulse  widths  varying  from  1.0  to  2.0 
milliseconds.  To  convert  these  servo  commands  into  surface  deflections  or  percentages 
of  the  throttle,  the  gains  presented  in  Table  3  can  be  applied. 

Table  2:  Input  variable  nomenclature 


Control  surface / device 

Servo  command 
(ms) 

Controller/pilot 
command  (ms) 

Servo  trim  value 
(ms) 

Ailerons 

V ailerons 

Sfcmd 
u ailerons 

Sftrim 
u  ailerons 

Elevator 

V elevator 

Sfcmd 
u  elevator 

Sftrim 
u  elevator 

Rudder 

& rudder 

Sfcmd 
u rudder 

Sftrim 

urudder 

Throttle 

$ throttle 

Sfcmd 
v throttle 

Sftrim 
v throttle 

2.5.2  Attitude  Output :  Error  quaternion 


The  error  quaternion  is  only  involved  in  control  and  represents  the  difference  between 
the  actual  and  the  desired  attitude,  as  illustrated  in  Figure  6.  In  this  figure,  qm,  qd 
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Table  3:  Input  conversion  gains  (ms  to  deg  and  % ) 


Control  surface/device 

Gain  (deg/ms) 

Gain  (%/ms)) 

Ailerons 

111.041 

n/a 

Elevator 

112.392 

n/a 

Rudder 

168.493 

n/a 

Throttle 

n/a 

%  =  125 

and  ge,  respectively,  represent  the  measured,  desired  and  error  quaternions  and  the 
circles  represent  the  reference  frames.  Therefore,  qm  represents  the  rotation  which 
brings  Re  to  Rb,  qd  brings  Re  to  the  desired  reference  frame  Re  and  qe  brings  Rb 
to  Rd. 

From  Figure  6,  a  reference  frame  relation  can  be  established  between  qm,  qd  and  qe 
and  take  the  form 

qd  =  qmqe 

By  isolating  qe,  the  equation  describing  the  error  quaternion  can  be  found  as 

qe  =  ( <T)-y  (11) 
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NED 


Desired 


Figure  6:  Error  quaternion 


2.5.3  Attitude  Setpoint  Generation 

The  attitude  is  set  by  the  desired  quaternion  qd.  In  hover,  qd  takes  the  value  of  a 
vertical  quaternion  facing  north,  qv,  as  defined  by 

qv  =  [0.7071,0,0.7071,0]' 


To  add  control  around  the  roll,  pitch  and  yaw  axis,  the  following  quaternions  are 
defined 


qro11  =  [cos(0/2),sin(0/2),O,O]' 
qpitch  =  [cos(0/2),O,sin(0/2),O]' 
qyaw  =  [cos(^/2),0,0,sin(^/2)]' 

where  (f),  6  and  'ip  define  the  roll,  pitch  and  yaw  setpoints  around  the  vertical  axis. 
The  mathematical  implementation  of  these  quaternion  is  carried  out  by 

qd  _  qV qroll  qpitch qyaw 


qv ,  however,  is  not  a  good  vertical  quaternion  when  the  air  vehicle  controller  is  ini¬ 
tialized  with  a  non-zero  heading  because  it  will  generate  an  immediate  yaw  correction 
which  might  temporarily  destabilize  the  air  vehicle.  Therefore,  to  generate  a  vertical 
quaternion  with  the  proper  initial  heading,  a  delta  quaternion  that  represents  the 
initial  aircraft  attitude  to  the  vertical  orientation  is  calculated  as  proposed  by  Green 
(2007)  and  used  in  Bilodeau  (2009). 
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2.5.4  General  Architecture 


The  control  architecture  (Bilodeau  (2009))  is  illustrated  in  Figure  7.  The  term  Gc  is 
defined  as  a  diagonal  3x3  matrix  composed  of  proportional-integral  (PI)  regulators 
of  the  form 


Gc 


Kc{TiS  +  1) 
TiS 


(12) 


Figure  7:  Representative  attitude  control  architecture 

Each  PI  is  implemented  with  an  anti- windup  form.  K,  is  a  3x3  diagonal  matrix 
composed  of  proportional  gains.  qd,  qm  and  qe  are  the  desired,  measured  and  error 
quaternions,  respectively.  ©  and  f2  are  the  error  angle  vector  [0, 6, 0]  and  the  angle 
rate  vector  [a Jx,u)y,uz].  8  is  the  manipulated  variable  vector  [S’aileronsS elevator,  8rudder\- 
Strv,n  and  S""d  are  the  trim  and  command  vectors,  respectively,  associated  to  d.  The 
input  8 throttle  is  not  considered  in  the  attitude  problem  because  it  is  considered  as  a 
perturbation  for  the  roll  controller. 

It  is  worth  noting  that,  in  Bilodeau  (2009),  qd  was  fixed  equal  to  qv  as  calculated  by 
Green  (2007)’s  algorithm.  It  is  also  worth  nothing  that  the  attitude  setpoints  were 
applied  on  ©  rather  than  in  qd.  While  this  implementation  is  not  elegant,  it  allows 
attitude  setpoints  to  be  directly  included  in  qd.  That  is  why  a  setpoint  of  zero  appears 
in  Figure  7. 

2.5.5  Tuning 

To  determine  the  controller  parameters,  a  tuning  method  based  on  frequency  response 
was  used.  It  relies  on  the  contours  of  the  Nichols  chart  and  is  described  by  Pomerleau 
and  Poulin  (1996)  and  Poulin  and  Pomerleau  (1996).  By  specifying  a  contour  which 
corresponds  to  the  maximum  peak  resonance  Mr  of  the  closed  loop  transfer  function, 
a  minimum  phase  margin  0m  and  a  minimum  gain  margin  Am  is  specified  to  control 
the  maximum  peak  overshoot  of  the  system  for  setpoint  changes. 
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For  the  cascade  loop  presented  in  Figure  7,  this  tuning  method  is  applied  on  the 
external  loop  to  follow  the  Mr  specification.  The  internal  gains  are  adjusted  to  accel¬ 
erate  or  decelerate  the  system  while  providing  the  highest  gain  crossover  frequency 
possible.  The  external  loop  is  used  to  eliminate  the  static  error.  The  maximum  Mr 
is  3  dB  which  will  result  in  a  good  compromise  between  performance,  overshoot  and 
oscillations.  The  minimum  Mr  for  low  frequencies  is  of  0  dB  to  ensure  no  static  error. 
Finally,  Figure  8  illustrates  acceptable  response  limits  for  the  tuning  of  the  attitude 
loops  and  for  any  process  stability  type  (stable,  integrator,  unstable). 


Figure  8:  Acceptable  response  limits  for  unstable,  integrator  and  stable  processes 


2.6  Altitude/Throttle  Control 

2.6.1  Architecture 

The  control  architecture  for  the  altitude/throttle  controller  is  illustrated  in  Figure 
9.  It  consists  of  a  proportional-integral-derivative  (PID)  controller  with  anti-windup 
and  an  anticipation  transfer  function  D  used  to  counteract  the  coupling  between  the 
ailerons  and  the  altitude/throttle.  For  the  altitude  measurement,  a  sonar  range-finder 
is  used.  Its  signal  is  filtered  with  an  anti-peak  algorithm  and  a  low-pass  filter  with  a 
time  constant  of  0.1  s.  The  anti-peak  algorithm  was  a  zero-order  hold  triggered  when 
II  Ah  || >  0.15  m. 
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Figure  9:  Altitude  control  architecture 


The  PID  structure  is  given  by 


Kc{TiS  +  l)(TrfS  +  1) 
Tis(Tjs  +  1) 


(13) 


2.6.2  Tuning 

The  tuning  method  is  the  same  than  for  the  attitude  controllers.  However,  to  obtain 
a  good  perturbation  rejection,  it  was  observed  that  a  very  high  phase  advance  is 
preferable  to  a  high  gain  adjustment.  Figure  10  illustrates  this  idea  with  a  typical 
second  order  transfer  function  and  an  integrator  pole  that  is  similar  to  the  altitude 
response  observed  with  the  actual  MiniAV. 


To  determine  D,  where  the  aileron  is  considered  a  perturbation  to  the  throttle  con¬ 
troller,  the  following  anticipation  design  equation  is  used 


D  = 


G 


aileron 


G 


throttle 


(14) 


where  D,  Gaueron  and  G throttle  represent,  respectively,  the  ideal  decoupler,  the  pertur¬ 
bation  transfer  function  for  the  aileron  command  and  the  process  transfer  function 
for  the  throttle  command. 
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Figure  10:  Typical  frequency  response  of  the  closed  loop  altitude  system 
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3  Hardware 


This  chapter  describes  the  hardware  used  to  acquire  the  data  presented  in  Chapter 
7.  The  airframe  is  first  presented  and  then  followed  by  the  autopilot.  The  additional 
sensors  are  comprised  of  a  sonar  range-finder  and  a  vision  system. 

3.1  Airframe 

The  MiniAV,  shown  in  Figure  11,  is  a  commercial-off-the-shelf  fixed-wing  airplane 
(Flatana,  Great  Planes)  which  has  a  0.91  m  wing  span.  The  test  vehicle  has  an 
all-up-weight  of  410  g.  The  propulsion  system  consists  of  a  RIMFIRE  26-28-1000kV 
brushless  motor  coupled  to  a  25  A  electronic  speed  controller  and  a  10x3.8"  propeller. 
The  aerodynamic  surfaces  are  controlled  with  micro  servos. 


Figure  11:  Flatana  from  Great  Planes 


3.2  Autopilot 

The  autopilot  is  a  Kestrel  2.2  from  Procerus  (see  Figure  12).  The  onboard  sensor 
suite  is  comprised  of: 

•  3  single-axes  rate-gyros; 

•  2  dual- axis  accelerometers; 

•  1  absolute  pressure  sensor; 
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•  1  differential  pressure  sensor  and; 

•  2  single- axis  magnetometers; 


Figure  12:  Procerus  Kestrel  2.22  (www.procerusuav.com) 


The  total  weight  of  the  autopilot  with  a  900  Mhz  Maxstream  modem  (XT09-MI)  is 
of  40  grams.  To  communicate  with  the  autopilot,  a  communication  box  is  used  (see 
Figure  13). 


Figure  13:  Communication  box  (www.procerusuav.com) 
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3.3  Additional  Sensors 


Additional  sensors  were  used  to  complete  those  available  on  the  Kestrel  autopilot. 
For  instance,  to  measure  altitude  in  near  to  earth  conditions,  pressure  sensors  are 
not  reliable.  As  a  first  attempt  to  solve  the  altitude  measurement  problem,  sonar 
range-finders  were  tested.  It  is  recognized  that  these  devices  are  dependent  on  the 
absorption  properties  of  the  exposed  surface,  the  sonar  inclination  and  the  distance 
between  the  sonar  and  the  exposed  surface. 

3.3.1  Vision  System 

The  vision  system  is  based  on  the  Optitrack  infrared  cameras  from  NaturalPoint 
(http: / / www.naturalpoint.com).  The  NaturalPoint  Tracking  Tools  was  used  to  record 
the  markers  on  the  MiniAV  in  3D  space.  The  reference  frame  of  the  vision  system  is 
fixed  during  the  calibration  with  a  calibration  square  (ground  plane).  The  reference 
frame  definition  is  shown  in  Figure  14.  It  was  found  that  on  the  calibration  square, 
a  Z  axes  appears  in  white  and  that  the  orientation  of  this  Z  axis  is  in  the  opposite 
direction  expected  when  using  Tracking  Tools.  This  error  comes  from  an  earlier 
version  of  Tracking  Tools  called  RigidBody  Toolkit  that  used  the  left  hand  convention. 


Figure  14:  Vision  reference  frame  relative  to  the  calibration  square 


3.3.2  Sonar  Range-Finder 

Three  sonar  range-finders  from  Maxbotix  were  tested  : 

•  MaxSonar  EZO; 

•  MaxSonar  EZ2  and; 

•  MaxSonar  EZ4. 

They  all  have  the  same  physical  size,  as  illustrated  in  Figure  15. 


20 


DRDC  Valcartier  TR  201 0-144 


Figure  15:  Maxbotix  MaxSonar  EZ  serie  (www.maxbotix.com) 


The  main  difference  between  the  different  models  is  their  level  of  sensitivity  to  detect 
small  objects.  The  associated  beam  patterns  for  each  of  the  sensors  are  illustrated 
in  Figure  16.  From  this  figure,  it  is  possible  to  observe  that  the  Maxbotix  EZO  and 
EZ4  are,  respectively,  the  most  and  the  least  sensitive  of  the  tested  sonars.  Figure  16 
shows  the  size  of  the  beam  pattern. 


Figure  16:  Beam  paterns  of  the  MaxSonar  EZ  serie  ( www.maxbotix.com) 


In  order  to  insure  that  all  three  sonar  range-finders  have  a  similar  response  and  re¬ 
spect  the  manufacturer  specifications,  each  sensor  was  tested.  The  measured  response 
of  the  MaxSonar  EZO,  EZ2  and  EZ4  are  illustrated  in  Figures  17,  18  and  19,  respec¬ 
tively.  It  is  possible  to  see  from  the  regression  linear  functions  that  the  sensitivity  of 
the  three  sensors  are  very  similar. 
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Figure  18:  Response  of  the  range-finder  MaxSonar  EZ2 
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Voltage  vs  Range 


0  10  20  30  40  50  60  70  80  90 

Range(po) 


Figure  19:  Response  of  the  range-finder  MaxSonar  EZ4 

Because  the  main  goal  of  this  application  is  to  control  the  aircraft  altitude  in  both 
outdoor  and  indoor  conditions,  tests  were  made  over  a  variety  of  surfaces  to  verify 
the  sensitivity  of  the  three  sensors.  Table  4  summarizes  the  observations  acquired 
during  these  tests.  From  Table  4,  it  is  clear  that  for  an  outdoor  application,  the  EZO 

Table  4:  Outside  characteristics  of  the  tested  sonar  range-hnders 


Sensor 

Grass  floor 

Rock  and  dust  floor 

Hard  floor 

6.5  m  distance 

MaxSonar  EZO 

Very  good 

Very  good 

Very  good 

Very  good 

MaxSonar  EZ2 

Fair 

Fair 

Very  good 

Very  good 

MaxSonar  EZ4 

0  detection 

Unstable  readings 

Very  good 

Unstable  readings 

is  the  most  suited  sensor  because  it  is  the  least  sensitive  to  the  texture  of  the  exposed 
surface.  Also,  it  can  detect  a  surface  as  far  away  as  6.5  meters  which  is  the  maximum 
rating  of  these  sensors. 

A  further  test  was  carried  out  where  the  motor  was  activated  as  measurements  were 
made.  Figure  20  illustrates  the  comparison  between  the  signals  measured  by  the 
sonar  and  by  the  vision  system.  The  measurements  of  both  systems  were  subtracted 
by  their  initial  value  to  allow  the  comparison.  Also,  an  offset  equal  to  the  sonar 
lower  deadzone  value  (0.15  meter)  was  added  to  the  sonar  output  because  the  initial 
conditions  were  setting  it  at  less  than  0.15  meters  from  the  ground.  The  comparison 
shows  that  the  output  of  the  sonar  generally  follows  the  actual  altitude  measurements. 
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Altitude  relative  to  the  ground(m) 


The  sonar  measurements  are  not  entirely  reliable  because  dropouts  must  be  filtered 
adequately  before  using  it  for  control.  Apart  from  the  presence  of  this  noise,  the  sonar 
range-finder  can  be  used  to  give  an  altitude  estimation  for  near  earth  conditions. 
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4  Sensor  Data  Filtering 


This  section  presents  the  implementation,  tuning  and  results  obtained  with  the  com¬ 
plementary  filter  discussed  in  Section  2.3. 

4.1  Attitude  Filter  Algorithm  Implementation 

The  calculation  order  of  the  complementary  filter  equations  is: 

1.  Initialize  the  quaternion  with  an  heading  of  0°  and  with  a  roll  and  a  pitch  angles 
calculated  with  the  normalized  accelerometers  readings.  (  9  =  arcsin(ax)  and  0 
=  -ay/cos(9)  ); 

2.  Calculate  the  confidence  gain  k\  according  to  the  unnormalized  accelerometers 
readings; 

3.  Estimate  the  actual  accelerometer  readings  with  the  past  update  of  the  esti¬ 
mated  quaternion; 

4.  Calculate  the  innovation  vector  u>; 

5.  Update  the  new  rate-gyros  bias  with  the  calculated  uj  (Forward  Euler  integra¬ 
tion); 

6.  Correct  the  rate-gyros  readings  with  the  estimated  bias  and  innovation  vectors; 

7.  Update  the  quaternion  with  the  corrected  rate-gyros  readings  (Forward  Euler 
integration); 

8.  Normalize  the  quaternion; 

9.  Return  to  step  2. 

4.2  Tuning 

It  is  possible  to  specify  k°  and  k°  by  fixing  (  which  is  the  damping  ratio  and  cn0  which 
is  the  cutoff  frequency  of  the  filter. 

For  this  application,  (  and  uj$  were  adjusted  by  comparison  with  the  experimental 
dataset  to  give  acceptable  filter  performance.  The  values  of  (  and  uq  were  set  to 
2  and  0.1  r/s,  respectively.  The  confidence  gain  k\  and  kpenaity  were  set  to  1.0  and 
100.0,  respectively. 

4.3  Comparison  of  the  Filter  Outputs  with  a  Vision 
System 

To  examine  the  performance  of  the  tuned  complementary  filter,  its  attitude  estimates 
are  compared  with  the  attitudes  measured  by  the  absolute  and  drift-free  vision  sys- 
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tem.  The  results  are  illustrated  in  Figure  21.  Apart  from  the  presence  of  a  drift  in 
the  roll  output  which  is  normal  because  of  the  absence  of  flux-magnetometers,  the 
results  are  excellent  for  the  hovering  mode. 


Figure  21 :  Comparison  between  the  outputs  of  the  attitude  estimator  without  mag¬ 
netometers  and  of  a  vision  system  :  -  fusion,  —  vision 
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5  Aircraft  Model  Identification 

5.0.1  Attitude  Model 


The  aircraft  attitude  model  that  used  an  offboard  controller  was  previously  identified 
in  Bilodeau  (2009).  Since  the  weight  distribution  of  the  aircraft  and  the  moment 
of  inertia  of  the  current  MiniAV  is  very  similar  to  the  one  previously  studied,  no 
additional  identification  testing  and  analysis  was  conducted.  The  only  difference 
between  model  used  in  the  previous  study  and  this  study  is  time  delay  present  in 
the  systems.  Because  all  calculations  and  measurements  are  done  onboard  with  the 
Kestrel  autopilot  instead  of  being  relayed  to  an  offboard  controller,  the  measured 
time  delay  was  reduced  from  0.17  s  to  0.05  s. 


With  the  new  time  delay  of  0.05  s,  the  attitude  models  are 

p(s)  / rad/s\  —  10.55e-0'05s  —scj)(s) 

^ailerons^S)  ^  TTIS  /  0.67s  T  1  5 ailerons (^) 


q{s) 

/rad/s\ 

-4.827 se~oms 

— s9(s) 

& elevator  (s') 

V  ms  / 

(1.67s  -l)(0.06s  +  l) 

& elevator  (^) 

r(s) 

/rad/s\ 

7.79se a05s 

— s^(s) 

&  rudder  \S) 

V  ms  J 

(1.43s  -l)(0.12s  +  l) 

$ rudder ( ^ ) 

(15) 

(16) 
(17) 


5.0.2  Altitude  Model 

Experimental  observations  and  modeling  show  that  the  inputs  5auer<ms  and  dthrottie 
are  both  coupled  to  the  altitude  output  h.  The  main  coupling  is  between  Sthrottie 
and  h.  This  coupling  was  identified  with  a  predictive  error  method  found  in  the  pro¬ 
cess  identification  tool  from  the  Matlab  system  identification  toolbox.  A  sampling 
time  of  0.05  s  was  used.  A  two  steps  approach  was  employed.  First,  the  throttle 
was  actioned  in  open  loop  with  large  excitations.  A  linear  time-invariant  model  was 
identified  assuming  small  perturbations  around  a  selected  operating  point  and  then 
validated  through  comparison  with  experimental  data.  The  fit  for  the  identification 
and  validation  dataset  are  illustrated  in  Figures  22  and  23.  The  residuals  are  pre¬ 
sented  in  Figure  24.  Because  the  identified  model  is  capable  of  capturing  the  main 
dynamics  of  the  validation  data  output  and  because  the  residuals  resemble  white 
noise,  it  was  concluded  that  the  open  loop  model  was  satisfactory.  No  attempt  was 
made  to  resolve  the  time- varying  offset  error  observed  in  Figure  23  at  this  point.  This 
question  is  re-visited  in  Sec.  6.2. 
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Figure  22:  Fit  for  the  open  loop  identification  of  the  coupling  between  5-throttie  and 
the  altitude.  Dashed  line  -  fit.  Solid  -  measured.  Relative  to  operation  points. 
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Figure  23:  Validation  fit  for  the  open  loop  identification  of  the  coupling  between 
S throttle  and  the  altitude.  Dashed  line  -  fit.  Solid  -  measured.  Relative  to  operation 
points. 
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Figure  24:  Autocorrelation  of  residuals  for  the  coupling  between  the  altitude  and 

3 throttle 

With  the  main  open  loop  altitude/throttle  coupling  transfer  function  identified,  a 
Proportional-Integral-Derivative  (PID)  controller  and  decoupler  (Subsection  2.6.2 
were  designed  to  close  the  loop  between  the  throttle  and  altitude  without  consid¬ 
ering  the  cross-coupling  with  the  ailerons.  With  the  throttle/altitude  controller  in 
place,  a  second  identification  test  was  carried  out  where  the  ailerons  were  actioned 
by  sending  rapid  setpoint  changes  to  the  roll  controller. 

Figures  25  and  26  present  the  fit  for  the  identification  and  validation  datasets  while 
Figure  27  presents  the  residuals.  It  can  be  seen  that  the  fit  is  excellent  and  that  the 
residuals  resemble  white  noise. 
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Figure  25:  Fit  for  the  open  loop  identification  of  the  coupling  between  5 microns  and 
the  altitude.  Dashed  line  -  fit.  Solid  -  measured.  Relative  to  operation  points. 
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Figure  26:  Validation  fit  for  the  open  loop  identification  of  the  coupling  between 
<5 ailerons  an d  the  altitude.  Dashed  line  -  fit.  Solid  -  measured.  Relative  to  operation 
points. 
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Figure  27:  Autocorrelation  of  residuals  for  the  coupling  between  the  altitude  and 

3 ailerons 

Table  5  presents  the  identified  transfer  functions  that  are  valid  for  the  experimental 
characterisation  conditions.  The  altitude  output  is  expressed  in  the  continuous  time 
domain. 

Table  5:  Identified  transfer  functions  for  the  altitude 


& ailerons  (nis) 

$ thottle  (ffis) 

h(m ) 

1.52e— 0  05s 
s(0.22s+l) 

23.97e-°-20s 

s(0.3s+l) 
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6  Control  Tuning 


This  chapter  presents  the  calculated  and  implemented  gains  for  the  attitude  and 
altitude  controllers.  It  also  details  the  frequency  responses  and  the  ailerons  to  altitude 
decoupler  design. 

6.1  Attitude  Control  Tuning 

Table  6  presents  the  calculated  and  implemented  tunings.  The  internal  gain  of  the 
pitch  controller  was  increased  from  —0.23  to  —0.30  to  reduce  the  low  frequency  os¬ 
cillations. 

Table  6:  Controller  parameters 


Controller 

Tuning 

T,{  s) 

KA  mf,  ) 

L \ rad/s ' 

Roll 

2.5 

3 

-0.35 

Calculated 

Pitch 

6.0 

2 

-0.23 

Yaw 

5.5 

2 

0.17 

Roll 

2.5 

3 

-0.35 

Implemented 

Pitch 

6.0 

2 

-0.30 

Yaw 

5.5 

2 

0.18 

To  illustrate  the  benefits  obtained  with  lower  time  delays,  open  loop  frequency  re¬ 
sponses  of  the  external  loops  are  generated  with  two  different  time  delays.  Based 
on  these  calculated  gains  and  on  the  models  given  by  equations  15  to  17,  Figure  28 
illustrates  the  frequency  responses  obtained  with  a  time  delay  of  0.17  s  and  0.05  s. 
The  associated  properties  of  the  closed  system  are  presented  in  Table  7.  From  this 
table  and  Figure  28,  it  is  clear  that  an  important  increase  in  gain  margin  is  obtained. 
The  increased  gain  margin  allows  a  greater  model  gain  uncertainty  to  be  present.  In 
practical  terms,  the  larger  margin  will  result  in  reduced  vehicle  oscillations  in  the 
presence  of  perturbations  or  in  transient  modes.  The  theoretical  reason  is  simple, 
with  a  time  delay  of  0.17  s,  increasing  the  gain  will  make  the  frequency  response 
cross  the  lower  section  of  the  high  dB  contours  resulting  in  an  oscillating  behavior  at 
higher  frequency.  However,  with  the  time  delay  of  0.05  s,  the  gain  increase  must  be 
bigger  to  create  the  same  behavior.  This  mean  that  a  lower  time  delay  results  in  a 
more  robust  controller  for  a  same  adjustment  of  the  controller  parameters. 
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(a)  Time  delay  of  0.17  s 


(b)  Time  delay  of  0.05  s 


Figure  28:  Frequency  response  of  the  attitude  controllers  with  different  time  delays 
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Table  7:  Property  of  the  closed  loop  system  with  the  0.17  s  and  0. 05  s  time  delay 


Controller 

c a co  (rad/s) 

u;i80  (rad/s) 

Ub  (rad/s) 

Mr  (dB) 

0m  (deg) 

(dB) 

Delay  (s) 

0.17 

0.05 

0.17 

0.05 

0.17 

0.05 

0.17 

0.05 

0.17 

0.05 

0.17 

0.05 

Roll 

2.07 

1.93 

6.60 

7.49 

4.53 

5.56 

1.5 

1.5 

59.24 

63.33 

6.09 

13.38 

Pitch 

2.82 

2.66 

9.09 

20.53 

6.27 

17.87 

2.8 

2.6 

49.43 

61.13 

6.26 

17.09 

Yaw 

2.68 

2.49 

8.09 

16.50 

5.41 

14.00 

3 

2.8 

47.61 

57.32 

5.70 

17.25 

6.2  Altitude/Throttle  Control  Tuning 


The  tuning  of  the  altitude  controller  is  done  with  the  main  coupling  transfer  functions 
given  in  Table  5.  The  resulting  PID  transfer  function  is  expressed  by 


Gh(s) 


0.025(2s  +  l)(1.8s  +  l) 
2s(0.01s  +  1) 


and  the  resulting  frequency  response  is  illustrated  in  Figure  29. 


(18) 


The  anticipation  transfer  function  was  calculated  using  transfer  functions  from  Table 
5.  The  ideal  decoupler,  omitting  the  time  delay,  can  be  found  as  follows 


G aileron  _  0.0634(0.3s  +  1)  0.0634(0.3s  +  1) 

Gthrottie  -  _ e_015s(0.22s  +  1)  ~  (0.22s +  1) 
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To  reduce  the  complexity  and  the  impact  of  an  eventual  identification  error,  a  static 
gain  is  preferred  to  the  decoupler  in  eq.  19  because  it  is  a  phase  advance.  The 
equivalent  static  gain  is  —0.1.  Figure  30  illustrates  the  step  response  of  the  cross¬ 
coupling  between  S0,j,erons  and  h  with  and  without  the  anticipation.  As  illustrated  in 
this  figure,  the  static  gain  can  perform  as  well  as  the  nominal  anticipation  transfer 
function  within  a  time  window  when  altitude  setpoint  changes  normally  occur. 
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7  Experimental  Validation  of  the  Tuned 
Controllers 


Experimental  results  obtained  with  the  controllers  described  in  Section  2.5  are  pre¬ 
sented.  The  measured  and  desired  quaternions  were  converted  to  vertical  Euler  rep¬ 
resentation  (</>,  9  and  ip)  for  convenience. 

7.1  Attitude  Control  Results 

Figures  31  to  34  illustrate  results  obtained  with  the  implemented  controller  param¬ 
eters  given  in  Table  6.  For  the  outputs  <p,  6  and  ip,  a  dotted  line  representing  ±  3° 
performance  bounds  is  added  around  the  setpoints.  The  ±  3°  bound  was  selected 
as  a  reasonable  target  for  the  evaluation  of  control  performance.  It  is  worth  noting 
that  is  equal  to  1.0  and  not  the  true  trim  value  in  hover  for  implementation 

reasons. 

Figure  31  illustrates  the  results  obtained  when  the  air  vehicle  is  maintained  in  hovering 
mode  with  negligible  commands  given  by  the  operator.  Between  5  and  8  seconds  of 
the  flight  test,  the  vehicle  is  pitched  back  to  bring  the  vehicle  closer  to  the  operator. 
From  8  to  32  s,  no  operator  inputs  are  given.  After  ~32  s,  some  correction  on  the 
pitch  and  yaw  commands  are  done.  In  these  conditions,  the  attitude  is  well  controlled. 
Note  that,  in  the  first  10  s,  the  vehicle  is  stabilizing  from  its  manual  launch,  therefore 
the  observed  roll  error  is  expected.  This  error  eventually  disappears  after  10  s. 

Figure  32  illustrates  results  where  the  vehicle  is  in  hovering  mode  and  the  roll  setpoint 
is  changed  constantly  to  assess  the  performance  of  the  roll  controller  and  verify  the 
interaction  between  the  ailerons  and  the  other  controllers.  The  results  show  that  the 
pitch  and  yaw  controllers  do  not  react  in  concert  to  the  changes  in  the  aileron  deflec¬ 
tions.  The  main  maneuvering  limitation  of  the  hovering  fixed  wings  can  be  observed 
in  the  results.  To  counteract  the  propeller  torque,  the  ailerons  have  to  operate  close 
maximum  deflection  permitted  by  the  aileron  servo.  The  lack  of  additional  aileron 
deflection,  after  the  propeller  torque  has  been  countered,  causes  the  observed  roll 
errors.  Saturation  of  the  ailerons  is  observed  when  the  command  reaches  -0.2  ms. 

Figure  33  illustrates  the  results  for  lateral  translations  commanded  by  changing  the 
yaw  setpoint.  In  this  test,  the  pitch  was  adjusted  to  position  the  vehicle  in  a  safe 
attitude  before  executing  the  translations.  It  can  be  seen  that  the  heading,  which 
corresponds  to  the  roll  angle,  changes  over  time.  This  drift  is  caused  by  the  lack  of 
a  heading  sensor  that  feeds  data  to  the  attitude  estimator.  The  error  observed  on 
the  yaw  angle  is  caused  by  inputting  yaw  setpoint  changes  faster  than  the  lateral 
dynamics  of  the  air  vehicle  allows.  With  slower  setpoint  changes,  the  yaw  controller 
is  capable  of  following  the  setpoints  easily.  The  conclusions  of  this  test  are  that  the 
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vehicle  tracks  the  behavior  in  lateral  translation  with  no  coupling  observed  between 
the  controllers  in  this  kind  of  maneuver. 

Figure  34  illustrates  the  results  where  all  the  setpoints  are  changed  to  move  the 
vehicle  randomly  in  space.  The  objective  of  this  test  is  to  prove  the  repeatability 
of  the  controllers  in  variable  conditions.  The  performance  of  the  pitch  and  yaw 
controllers  is  still  excellent.  However,  the  saturation  of  the  ailerons  still  generates 
error  in  roll. 

Globally,  the  results  obtained  for  the  angles  6  and  if)  in  Figures  31  to  34  are  better  than 
those  obtained  by  Bilodeau  (2009).  The  onboard  control  system  has  less  time  delay, 
resulting  in  increased  stability  margins  and  better  dynamic  performance.  Another 
contributor  to  the  improved  performance  can  be  attributed  to  increased  structural 
stiffness  of  the  airframe  used  in  the  experiments.  It  was  observed  that  if  the  airframe 
has  a  weakness  between  the  empennage  and  the  fuselage  where  the  inertial  sensors 
are  installed,  the  structural  vibrations  generated  by  this  weakness  will  be  read  as 
angular  oscillations  by  the  sensors.  Appropriate  structural  reinforcement  eliminated 
this  problem.  The  results  obtained  for  the  angle  (j)  are  in  general  very  well  regulated. 
However,  the  torque  generated  by  the  propeller  may  be  too  high  for  the  roll  control 
available  in  this  platform  design.  A  counter-rotating  propeller  unit  may  be  a  solution 
to  reduce  the  torque. 
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Figure  31:  Flight  results  # 1  obtained  with  the  Flatana 
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Figure  32:  Flight  results  # 2  obtained  with  the  Flatana 
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Figure  33:  Flight  results  #3  obtained  with  the  Flatana 
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Figure  34:  Flight  results  # 4  obtained  with  the  Flatana 
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7.2  Altitude/Throttle  Stabilization  Results 


Tests  on  the  altitude/throttle  controller  were  carried  out  with  and  without  the  an¬ 
ticipation  transfer  function  (Subsection  2.6.2)  activated  to  see  what  the  gain  in  per¬ 
formance  would  be.  The  results  obtained  with  the  anticipation  function  disactivated 
are  illustrated  in  Figure  35.  ft  can  be  seen  that  the  ailerons  generate  perturbations 
on  the  altitude.  Figure  35  shows  that  all  perturbations  fall  within  a  ±25  cm  bound 
around  the  setpoint.  Figure  36  shows  the  altitude/throttle  control  with  the  anticipa¬ 
tion  function  activated.  The  ailerons  saturate  to  the  same  extent  as  the  previous  test, 
except  the  perturbations  now  all  fall  within  a  ±10  cm  bound.  These  results  clearly 
demonstrate  the  benefits  of  the  roll-throttle  decoupler. 


Figure  35:  Flight  results  with  altitude  controller  :  ± 0.25  cm  bounds 


44 


DRDC  Valcartier  TR  201 0-144 


Figure  36:  Flight  results  with  altitude  controller  and  static  decoupler  :  ± 0.10  cm 
bounds 


7.3  Effect  of  the  Throttle  on  the  Roll  Controller 

The  effect  of  throttle  changes  on  the  roll  controller  is  investigated.  To  better  observe 
the  response  of  the  roll  controller,  the  anticipation  transfer  function  (Subsection  2.6.2) 
was  de-activated. 

Figure  37  illustrates  the  results  of  the  test.  The  test  was  achieved  by  trying  to  keep 
the  altitude  constant  while  modulating  the  throttle  manually.  It  can  be  seen  in  the 
results  that  the  perturbations  induced  by  the  throttle  changes  are  very  well  damped. 
Some  overshoots  occur  around  15  s  because  the  ailerons  are  momentarily  saturated. 
This  behaviour  is  also  observed  between  27  and  35  s.  Based  on  these  results,  it  was 
concluded  that  a  decoupler  for  the  roll  controller  to  cancel  out  the  effect  of  the  throttle 
was  unnecessary. 
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Figure  37:  Flight  results  # 3  -  Effect  of  throttle  variation  on  the  roll  controller 
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8  Conclusions 


The  theoretical  basis  for  measuring  the  attitude  and  altitude,  and  stabilizing  a  mini¬ 
aerial  vehicle  while  being  flown  in  a  hovering  position  was  presented.  A  cascaded 
PI  control  architecture  based  on  quaternion  attitude  measurements  and  a  PID  al¬ 
titude/throttle  controller  with  anticipation  due  to  aileron  perturbations  were  for¬ 
mulated  and  implemented  on  an  onboard  autopilot.  A  complementary  filter  was 
employed  to  improve  the  stability  and  reliability  of  the  attitude  measurements  that 
fed  the  controllers.  Tuning  of  the  attitude  and  altitude/throttle  control  gains  was 
first  accomplished  on  a  calibrated  dynamic  6DOF  airplane  model  using  a  frequency 
response  method  to  meet  the  desired  performance  goals.  The  calculated  gains  did 
not  change  significantly  when  implemented  in  the  test  vehicle,  indicating  that  the 
airplane  model  dynamics  were  equivalent.  The  implementation  of  the  controllers  on 
the  onboard  autopilot  reduced  previous  system  delays  from  0.17  s  to  0.05  s.  The 
result  was  a  significant  increase  in  the  amplitude  margin  from  roughly  6  to  17  dB 
in  the  pitch  and  yaw  axes.  This  increase  in  margin  allows  the  controller  to  handle 
greater  model  gain  uncertainties  and  to  better  reduce  oscillations  if  the  vehicle  is 
perturbed  from  its  equilibrium  position.  The  experimental  data  showed  that  throttle 
commands,  compensated  for  aileron  effects  through  an  anticipation  function,  reduced 
the  altitude  hold  error  from  ±25  cm  to  ±10  cm,  thereby  validating  the  necessity  of  a 
roll-throttle  decoupler  to  stably  hover  an  aircraft  of  this  type  at  a  fixed  altitude. 
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9  Recommendations 


A  control  architecture  based  on  classical  proportional-integral-derivative  techniques 

was  developed  for  a  platform  with  a  standard  fixed  wing  configuration  to  enable  it  to 

hover  stably  in  ideal  conditions.  Future  work  should  address  the  following  items: 

-  Employment  of  nonlinear  parameter  identification  to  better  capture  the  bechavior 
of  a  hovering  fixed  wing  platform  beyond  the  localized  set  point  conditions. 

-  Development  of  a  six  degree  of  freedom  flight  dynamics  model  that  better  captures 
the  nonlinear  behavior  of  a  hovering  fixed  wing  platform. 

-  Investigation  and  comparison  of  other  control  methods  to  evaluate  their  effective¬ 
ness  and  their  computational  demands. 

-  Investigation  of  the  ability  of  the  platform  and  control  scheme  to  compensate  for 
exogeneous  disturbances. 

-  Investigation  of  other  platform  planforms  and  control  surface  configurations. 
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Annex  A:  User  Guide 


Before  executing  a  flight  demonstration,  it  is  necessary  to  have  the  following  items  : 

-  A  computer  capable  of  running  DevDemo.exe  (provided  on  the  CD); 

-  A  Kestrel  communication  box  connected  to  the  serial  port  5  of  the  computer; 

-  An  air  vehicle  with  the  Kestrel  autopilot  mounted  onboard; 

-  A  joystick  as  illustrated  in  figure  A.l;  and 

-  Fully  charged  2-  and  3-cell  lithium-polymer  batteries. 


Coarse  throttle 
control 


Down  :  Stabilization  olf 
Up  :  Stabilization  on 


Down :  Datalogger  on 
Middle  :  Neutral 
Up  :  Activate  Sonar 


Up  :  Hovering  mode 
Down  :  Level  flight 
mode 


f  :  Fine  throttlecontrol 
«-» :  Roll  control 


1  :  Pitch  control 
:  Yaw  control  I 


INI!  HLlN i 

■  '«oua 


i  ii t.iii. i 


Activate/Desactivate 


motor 


Figure  A.l :  Joystick  and  switch  configurations  on  the  controller  handset 


To  execute  the  demo,  follow  the  following  step  : 

1.  Verify  that  the  communication  box  is  connected  to  the  communication  (COM) 
port  5  of  the  computer; 

2.  Verify  that  the  controller  handset  is  connected  to  any  USB  port  of  the  computer 
and  that  the  switches  are  in  a  safe  state  (stabilization  off,  sonar  loop  not  enabled, 
and  hovering  mode); 

3.  Power  on  the  communication  box; 
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4.  Place  the  air  vehicle  horizontally  on  the  ground; 

5.  Plug  the  2-ccll  lithium-polymer  battery  to  the  autopilot  power  connector; 

6.  Open  the  application  DevDemo.exe,  an  interface  as  illustrated  in  Figure  A. 2 
should  appear; 

7.  Click  on  the  "Open  port"  button; 

•  If  the  port  has  opened,  the  "Open  port"  button  with  disable  itself; 

•  Otherwise,  verify  the  communication  box  is  connected  to  COM5; 

8.  If  a  datalog  is  desired,  first  specify  the  duration  and  the  sampling  rate  in  the 
textbox  contained  in  "Datalog"  button  group.  Then  the  datalog  can  be  started 
manually  with  the  "StartDatalog"  button  or  automatically  at  the  flight  test 
beginning  by  setting  the  joystick  tristate  switch  to  the  "Datalogger  on"  position; 

9.  The  PID  controller  parameters  can  be  modified  with  the  text  boxes  contained 
in  the  "Cascade  Loop  Tuning"  group; 

•  Two  controller  modes  are  available,  the  level  flight  mode  and  the  hovering 
mode,  these  controllers  can  be  chosen  by  checking  or  not  the  checkbox  located 
under  the  "GetDefault. Values"  button  which  is  used  to  retrieve  default  values. 

•  To  download  the  PID  parameters  values  to  the  autopilot,  click  on  the 
"SetFlashValues"  button; 

•  To  retrieve  the  PID  parameters  values  in  the  autopilot,  click  on  the  "Get- 
PIDValues"  button; 

10.  To  verify  that  the  attitude  estimator  is  not  giving  false  estimations,  a  blue  tri¬ 
angle  is  drawn  in  the  3D  environment.  The  longest  side  of  the  triangle  indicates 
the  right  side  of  the  vehicle; 

11.  Plug  the  3-cell  lithium-polymer  battery  to  the  ESC  power  connector; 

12.  Lift  and  hold  the  aircraft  in  a  vertical  attitude  (nose  pointing  up); 

13.  Press  the  red  button  (motor  activation)  on  the  controller  handset; 

14.  Start  the  motor  by  activating  stabilization  (stabilization  switch  on),  put  the 
fine  throttle  control  at  \  travel  and  adjust  coarse  throttle  control  in  a  position 
where  the  aircraft  can  lift  itself; 

15.  Switch  off  the  stabilization  (stabilization  switch  off)  to  reset  the  controllers  and 
to  ensure  a  proper  takeoff; 

16.  Place  the  aircraft  vertically  before  the  take  off  sequence; 

•  Manually  control  the  rate  of  ascent  for  vertical  take-off  with  the  throttle 
(the  orientation  will  be  stabilized); 

•  When  the  desired  altitude  is  reached,  activate  the  sonar  loop  which  will 
automatically  hold  the  airplane  at  constant  altitude; 

17.  To  land,  de- activate  the  sonar  loop  and  manually  control  the  altitude  with  the 
throttle  until  the  airplane  has  landed; 

18.  When  the  vehicle  has  landed,  turn  off  the  stabilization  (stabilization  switch  off). 
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Figure  A.2:  Interface  built  for  study 
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